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Abstract: The paper presents the concept of controlling the designed optoelectronic scanning and 
tracking seeker. The above device is intended for the so-called passive guidance of short-range 
anti-aircraft missiles to various types of air maneuvering targets. In the presented control method, 
the modified linear-quadratic regulator (LOR) and the estimation of input signals using the extended 
Kalman filter (EKF) were used. The LOR regulation utilizes linearization of the mathematical model 
of the above-mentioned seeker by means of the so-called Jacobians. What is more, in order to improve 
the stability of the seeker control, vector selection of signals received by the optoelectronic system 
was used, which also utilized EKF. The results of the research are presented in a graphical form. 
Numerical simulations were carried out on the basis of the author’s own program developed in the 
programming language C++. 


Keywords: simulation; mechatronics; control systems; guided missile; flight dynamics; LQR control; 
Kalman filter 


1. Introduction 


One of the most important components of an anti-aircraft self-guiding infrared missile 
is the optoelectronic self-guiding seeker. This type of device is still the subject of intensive 
research in many scientific centers around the world [1-15]. The issue of this article refers 
to the publications [16,17] and is a continuation of the research conducted on the designed 
optoelectronic scanning and tracing seeker, presented in Figure 1. 

The drive system of the designed scanning and tracking seeker is the rotor shown 
in Figure 1a. It is suspended in two rotating housings forming the so-called Cardan joint 
(Figure 1c). The rotor axis is the optical axis of the search and tracking system for a detected 
target. By means of the motors mounted in the individual housings (Figure 1b), control 
moments are applied to the rotating rotor, which makes it possible to change the position 
of its axis in space and thus to control the seeker. Figure 1d shows a 3D visualization of the 
complete seeker. Thanks to the 3D software, the mathematical and dynamics model and 
problem of moving parts are easier to solve [18]. Figure 2 shows the seeker set in the first 
operating mode in which the device scans the air space with the so called large angle of 
scanning B = 1.92’. 

Figure 3 shows the area of the airspace scanned by the seeker set in the first operating 
mode (the plane is scanned perpendicularly to the head axis). 

Figure 4 shows the seeker set in the second operating mode, where the device scans 
the air space with a so-called small scanning angle $ = 0.28. 

Figure 5 shows the area of air space scanned by the seeker set in the second operating 
mode (the plane scanned is perpendicular to the seeker axis). 
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a) b) Fiber-optic angular displacement sensor 
Complete gyro rotor 


c) Spherically-shaped outer housings 


Spherically-shaped inner housings 


Complete scanning head / 


Figure 1. 3D view of the designed scanning and tracking seeker, where: (a) gyro rotor of scanning 
system; (b) sensors and control motors of the seeker; (c) spherically-shaped forming a cardan 
arrangement; (d) complete scanning head. 
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Figure 2. Scanning and tracking seeker set in the first operating mode. 
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Figure 3. The area of scanned airspace in the first operating mode of the seeker. 
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Figure 4. Scanning and tracking seeker set in the second operating mode. 


The detailed principle of operation and innovation of the seeker is presented in [16,19]. 
At the present stage of research, a mathematical model of the dynamics of the presented 
device has been developed, various algorithms of control of the seeker’s optical axis have 
been analysed in [16,20-23], and optimal operating parameters of the seeker have been 
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determined while maintaining the stability conditions specified by the so-called Lapunov 
method [24]. In the course of the above-mentioned research, problems with precise control 
of the device axis in the so-called second operating mode of the seeker (Figure 4), in 
which the seeker tracks the previously detected air target with the small scanning angle 
(Figure 5).It should be noted that this type of solution for detection (space scanning) and 
tracking of the maneuvering air target is not described in the available literature. After a 
deeper analysis of the problem, it turned out that it is caused by too many pulses from 
infrared radiation emitted by the target that are received by the optoelectronic system. Too 
many detection pulses cause unfavorable overdriving of the seeker axis. It was, therefore, 
advisable to carry out additional filtering of signals received by the optoelectronic system. 
For this purpose, the so-called vector selection of signals received by the optoelectronic 
system was used, with a Kalman filter added [25-28]. Moreover, the so-called modified 
LOR control method was used to increase the precision of the seeker axis control. The 
results of this work are presented in subsequent points of this paper. 


0.3 5 


0.15 f 


0.15 f 


Figure 5. The area of scanned airspace in the second operating mode of the seeker. 


2. Mathematical Model of the Scanning Seeker 


Figure 6 shows the scanning seeker diagram together with the adopted coordinate 
systems and markings of individual angles of rotation of the respective systems in relation 
to each other. The origins of all coordinate systems are located at the intersection of the 
axis of rotation of the outer housing with the axis of rotation of the inner housing of the 
seeker. The movement of the seeker axis can be induced by moments of external forces Mz 
and Mw forces generated by control motors or by moments of friction forces Mrw and 
Mrz forces generated in the bearings of particular seeker housing as a result of angular 
displacement of the missile deck. 

Angular movements of a missile are treated as external disturbances and are deter- 
mined by the angular wyp, Wyp, Wz», velocities that cause the missile to rotate around the 
individual axes of the system xp yp zp at the appropriate angles a, ay az. Angles 4, 0 
are measured with fiber optic sensors (Figure 4) and angle ¢ is measured with the rotor 
position sensor (Figure 2). 
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Figure 6. Seeker diagram with adopted coordinate systems. 


The following coordinate systems have been introduced: 


XK YK ZK—a coordinate system associated with the reference direction established in space; 
XR YR ZR—a mobile coordinate system associated with the rotor; 

xcw Yow Zcw—a mobile coordinate system associated with the inner housing; 

xcz Ycz Zcz—a mobile coordinate system associated with the outer housing; 

Xp yp Zp—a mobile coordinate system associated with a missile; 


The following marking of the angles of rotation has been adopted: 


w-angle of rotation xcz ycz Zcz relative to xx yx Zx around axis Zcz; 
v-angle of rotation xcw Ycw Zcw relative to xx yx ZK around axis Xcw; 
g-angle of rotation xr YR Zp relative to xx yx Zk around axis yR; 
«y-angle of rotation xp yp Zp relative to xx yx Zx around axis Xp; 
ay-angle of rotation xp yp Zp relative to Xx YK ZK around axis yp; 
«z-angle of rotation xp yp Zp relative to xx yx Zx around axis Zp; 


The following were assumed as given values: 


Ixez1 Jycz Jzcz moments of inertia of the complete outer housing, 
Ixcws Tycws Jzcw—moments of inertia of the complete inner housing; 
Jxp1 Tyg, Jzg—moments of inertia of the rotor; 

a 


Mz—the moment of forces of control motor’s action on the outer housing; 


—> 
My—the moment of forces of control motor’s action on the inner housing; 
© P(Wxp, Wyp, Wzp )—angular velocity of the missile; 
n-rotational speed of the rotor; 
=> => 
Mrw, Mrz—the moments of the friction forces in the bearings of the inner and outer 
= . > N 
housing, hereby: Mrw = cw?, Mrz = cztp, here: cw is a coefficient of friction in the inner 
bowl bearing and c; is a coefficient of friction in the outer bowl bearing. 
Using the Lagrange II equation, the following gyroscope motion equations have been 
derived [29]: 


(Jxcw f Jxg)8 (Jxcw f Jsr)Wzcz (Jycw Jzcw Jzr)VycwWzcw + (1) 
—JyrnWzcw = Mw — Mrw 
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[zez + Jzew + Jzr t (Jycw Jzew Tzr) sin? o] Wzcz+ 

+4 (Jycw — Tzow 7 Jzr) sin 20 | W278 + Wycz a 

[zew Jap (Jycw Jzcw Izr) sin? o] Wycz? = (Jzcw + Jag )WzewWxcw sin 0+ (2) 
+ ycwycwWxcw COS B+ JygNWxcy COs È — vez = Jycz) @xcz Wycz t 

—(Jxcw Tr: Ixp)OxewWycz = Mz — Mrz 


where the components of the angular velocity of the outer housing: 
Wxcz = Wyp COSY + Wy, SiN Y 
Wycz = —Wxp SIN Y + Wyp COS Y 
Wzcz = $ + Wzp 
and the components of the angular velocity of the inner housing: 
Wrcwy = Wxcz +O 
Wycw = Wycz COS Ò + Wz, sind 
Wzew = —Wycz SİN Ò + Wz, cos B 
Assuming that external kinematic impacts are negligible, we will obtain the following 
system of equations of motion of the seeker: 


(Jxcw + Ixg)0 (ae Jzcw Jar) P sin20 — Jypný cos +cwð = Mw (3) 


Uzcz + Jzew + Jer + (Jycw — Jeew — Jer) sin? 8] + (Jycw — Jzcw — Jzr) $9 sin 20+ a) 
+Jygnv cos 8 +czp = Mz 


3. LOR Control of the Scanning Seeker 


In this article, the authors proposed to control the seeker axis by means of a modified 
linear-quadratic regulator (LOR). This method can be used to determine such control that 
minimizes the integral quality indicator, given by the formula: 


J= Í [x"Qx + u" Ru]dt (5) 
0 


where Q = matrix of state variable weights, R = matrix of control weights, x=state vector, u 
= [My — Mrw]'- control vector. 

Q and R matrices are diagonal weight matrices that can be used to change the influence 
of particular state variables and controls on the presented quality criterion. The advantage 
of this method is that the entire state vector is the set point value, not just its selected values, 
as is the case with other controllers (e.g., PID) [30-33]. 

LOR regulation requires linearization and discretisation of state equations. Jacob’s 
matrix—a matrix of successive partial derivatives—was used in the process of linearization. 

To Equations (3) and (4), we introduce the signs: 


Ja = Jxew A Jxg» Js2 = Jycw = Jecw = Jz, Js3 = Jzcz + Jew as Jzg 


x1 = 0,%2=8,x3=, 4 =P (6) 
thanks to which we get a nonlinear system of equations: 
x = f(x) (7) 


where: 
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X2 
x 1 Joo 42 gj Jug _ cwx2 4 Mw 
c1 zj x4sin 2x1 + ja "1X4 COS X1 Ta + Ta 
ae Mt = X4 
X3 Js2x4x2 sin 2x1 Jyg”x2 cos x1 Gsi ; 
n E a ° T 
X4 (Js3+Js2 sin? x1) (sat Jegsin® x1) — (Jsa3+Js2 sin? x1) 

Z 


(Js3+Js2 sin? x1) 
Then, in the above system, the components dependent on the so-called owndynamics 
of the system (state variables) and the components dependent on external actions (control 
moments) will be separated, as shown below: 


xy fi z1 
Mo |_| fe |. | 2 | 
X3 f 23 
X4 fa Z4 


| i 
7 zx sin 2x1 + We nx, COs x1 4 
= zi (8) 


JsaX4xX2 sin 2x1 Jug nX2 COS X1 
(UsatJs2 sin? x1) — (Js3+Js2 sin? x1) 


_ CwX2 , Mw 


Isa Jsi 
j 0 


CoX4 Mz 
(Js3+Js2 sin? x1) (Js3+Js2 sin? x1) 


where: 


fi = a component dependent on the own dynamics of the system, 
Zi = a component dependent on control and external interference: 


The control law takes the form: 
u = K(xz =x) (9) 


where xz is the matrix of set state variables, while the matrix of amplification is calculated 
from the dependency: 


K = (R +B! PB) 'BTPA (10) 
where P matrix is the solution to Riccati discrete equation [34,35]: 
ATP +PA — PBR7!B'P = 0 (11) 


Selection of LQR regulator settings consists in the determination of the Q and R 
weights matrices. The LQR algorithm does not have a universal method for selecting the 
above parameters and they are usually iteratively selected. In this paper, when selecting 
the initial values of Q and R matrices, the authors used the Bryson [36] rule, which suggests 
the selection of the following input parameters: 


1 

Qii = > (12) 
Xii 
1 

Ri = > (13) 
uii 


where i-means another element of the state vector; x;;i—these are the maximum values for 
individual elements of the state vector x; uj;j—these are the maximum control moments. 
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The maximum operating parameters of the seeker were determined using the Lapunov 
method [24], and they are respectively: 


u1 = Uy = 1.5 (N - m), x4 =0.5(), x99 = 40 ( /s), x33 = 0.5), x44 = 40(° /s) 


Q and R weights matrices: 


ae 0 0 0 
0 4&4 0 0 
= 402 
Q 0 0 T 0 
( 1 

0 0 0 & 

1 
R=| 15 n | 

0 TR 


The P matrix was determined by numerically solving Riccati discrete equations ac- 
cording to the formula: 


Pj-1 =Q+A7(P; — PjB(R + B'PB) *BTP)A (14) 


Matrix Pj- according to the above formula, is calculated iteratively from the back. P; 
= Q is assumed as the input value. Jacobians were used to determine the state matrix A 
and control matrix B [37]. The individual elements of the matrix A are given according to 
the dependency: 


A= Ox; OX2 Əx3 OX, (15) 


After calculating the partial derivatives, further elements of the matrix A were deter- 
mined, represented by the following equations: 


oft afi afi afi 
= = = = 1 
0x1 o, 0X2 1, 0x3 % 0x4 y ( sa) 
f2 Js2x3 cos 2x1 y, f2 0, Ofz 0 (15b) 
Oxy Isa 0x2 0x3 
Of _ Js2x4 sin 2x1 + Jygn cos x1 (150) 
Ox4 Jsi 
df3 dfs ofz d f3 
= = = = 1 
Oxy 0, ax2 0, 0x3 u Ox4 ; (tod) 
dfa __ —2]s2X2X4 COS 2x1 +Jyp "X2 Sin x1 j 
Ox} Us3+ Jez sin? x1) 
i J2 x2x42 sin x4 cos x; sin 2x1+Js2]yg NX cos? x12 sin x} (15e) 
i (Js3+Js2 sin? x)" 
Ofg — —Js2xXqsin 2x1 — Jug cos x1 (156) 
dx2 (Js3 + Jsz sinf x1) 
ofa 
Ma o 1 
T 0 (158) 
dfa _ —Js2X2sin2x1 (15h) 


0X4 (Js3 + Js2 sin? x1) 
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The individual elements of the matrix B are given according to the dependency: 


Oz əz 
ou, duo 
az, Oz. 
— ou duz 
B= | 34 az (16) 
du, Juz 
əz dzi 
ou, duo 


After calculating the partial derivatives, the individual elements of the control matrix 
B were obtained, represented by the following equations: 


al 0Z1 

< =0, — = 1 
ðu g duz 0, ( a) 
Z2 0Z2 1 

= = 16b 

dy” dmz Ja” nen) 
0z3 0z3 

pet = pu 1 
ey 0, (16c) 

OZ4 1 OzZ4 


= > = 0. 16d 
ður (Jsa + Jan sin? x1)" Ou2 (26a) 


4. Vector Filtration of Control Signals by Means of the Extended Kalman Filter 


The accurate angle measurement of the detected object has a significant impact on the 
accuracy of its tracking [38—42]. In order to correctly determine the angular position of the 
detected object, it should be determined the law of airspace scanning by the optoelectronic 
system. 

The law of airspace scanning by the optoelectronic system of the seeker is presented in 
the paper [19]. On its basis, linear equations describing the model of the scanning process 
were derived: 


x(t) = atan(tan((t)) - cos(asin(zzp(t) Iy] tpt}? +zzp(t)’)) (17) 


z(t) = atan(tan(A(t)) - sin(a sin(zzp(t) sy Xzp(t)? + Zzp(t)*)) (18) 
where: 


Bx(t), Bz(t)-angular coordinates of the detected target relative to the axis of the scanning 
seeker; 

B(t)-resultant angle of deflection of the light beam from the optical axis: 

Xzp , Zzp-the components of the position of the light beam on the plane of the original 
mirror. 


Angular coordinates of the detected target Bx , Bz are measured with respect to the 
optical axis of the seeker. These coordinates are the position desired to control the axis of 
the seeker so that it tracks the detected target. 

Due to the high scanning density, especially in the second operating mode of the 
seeker (see Figure 5), there is a large number of pulses received from the infrared detector, 
which causes an unfavorable overdriving of the seeker axis. For the reasons mentioned 
above, it was necessary to apply appropriate filtration. Although a large number of control 
signals do not cause losing track of the target, it has a negative effect on the precision of the 
control. The method of filtering signals received by the optoelectronic system of the seeker 
presented in the paper is divided into two stages: 


- selecting the maximum signal (pulse), 

- performing additional filtration of the determined maximum signals using the EKF. 
Figure 7 shows a diagram of filtering the signals received by the optoelectronic system 

of the seeker. 
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PzC) 


B, 


O Pr. BA 


Figure 7. Diagram of filtering signals received by the optoelectronic system of the seeker. O, current 
position of the seeker axis; A, infrared detector pulses; B, selected maximum pulses; C, currently set 
angular position for controlling the seeker axis; D, status vectors (one of the Kalman filter criteria); 
E, selection area (one of the Kalman filter criteria); F, next, set angle position for controlling the 
seeker axis (result of filtration operation); G, target flight trajectory; H, set trajectory for seeker axis 
movement; Ra, corrective lens system visual field radius; AB, variable coefficient depending on the 
speed vector value of the detected Vwc target. 


Based on the series of pulses from the infrared detector, only those for which the 
voltage value is the highest, i.e., theoretically the closest to the source of infrared radiation, 
are taken into account. These are the so-called maximum pulses marked in Figure 7 with 
the symbol B. At the next stage of selection, the Kalman filter was used, in which a variable 
coefficient AB was adopted as one of the quality criteria (see Figure 7), depending on the 
value of the Vwc velocity vector. The coefficient AB varies from 1.5 Ra to 6 Ra, where 
Ra is the radius of the visual field of the seeker corrective lens system. The algorithm 
according to which the Kalman filter works is divided into two stages. The first stage is 
called prediction and the second stage is called correction. During prediction, the velocity 
vector of the detected target is estimated based on the previous coordinates of the detected 
target [43-45]. 

Estimated values of the direction and orientation of the target velocity vector are 
additional quality criteria for filtering those maximum signals whose vectors have the 
opposite direction and orientation compared to the Vwc vector. Vectors of measurement 
signals are marked with the “r;” symbol in Figure 7. 

The prediction of the direction and orientation values of the target velocity vector is 
based on the matrix of coordinates of the detected target: 


Bx(to) Bz(to) 
Bx(ti) Bz (t1) 
B= | Bx(tz) Bz(t2) (19) 


Bx (ti) Bz(ti) 


where i = number of target detection pulses. 
Equations describing the estimated velocity vector of a detected air target: 


v/(tg(Bx(ti) — Bx(ti— At)))? + (tg(Bz(ti) — Bz (ti — At)? 


F =A 20) 


vwc(t) = 
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ywc(t) = en - 21) 
(tg(Bxeq — Bx(t:))}? + (t8 (Bzer — Bz (ti))) 
(rs 
Bza = (22) 
(bm 
Bz = (23) 


1 


where: vwc = estimated value of the target velocity vector, ywc = estimated direction of 
the target velocity vector, t; = time of measurement of consecutive pulses from the infrared 
detector, At = reverse time interval (in numerical simulations, it is the time of about 10 
detection pulses). 

In the next stage of filtration, called correction, the final control signal is determined 
(Figure 7, point E), for which the value of the determined “r;” vector is greater than or 
equal to the quality AB coefficient. Signals selected in this way Bx , Bz have been used to 
control the seeker axis and thereby track the detected air target, as described in the next 
chapter of the paper. 


5. Results 


The studies were carried out for different air situations. Numerical simulations were 
carried out on the basis of the author’s own program developed in the C++ language. 


5.1. Scanning Seeker Parameters 


Moments of rotor inertia: 

Ing = 0.00114143 (kg +m?) ; Jyp = 0.00157911 (kg -m?) ; Jzg = 0.00158234 (kg - m?) 
Moments of inertia of the complete inner housing: 

Icy = 0.016663 (kg : m?) ; Jycy = 0.001166 (kg -m?); Jecy = 0.0011463 (kg - m?) 
Moments of inertia of the complete outer housing: 

Jzcz = 0.003383 (kg -m?); Jycz = 0.000213 (kg -m?); Jac, = 0.0002583 (kg : m?) 


Rotational speed of the rotor: 
n = 600(rad/s) (The speed and torque of the motor depend on the strength of the magnetic 
field generated by the energized windings of the motor, which depends on the current 
through them-may slightly differ from the fixed value [46]). 

The coefficient of friction in the inner housing bearing: 
Cw = 0.05 (N -m-s) 

The coefficient of friction in the outer housing bearing: 
cz = 0.05 (N -m - s) 


5.2. Results of the Simulation 


Figure 8 shows a computer simulation image of the tracking of an air target moving at 
a speed of 350 m/s, located at a distance of 1600 m from the firing position, without the 
use of a filtration of pulses received by the optoelectronic system of the seeker. 

Figure 9 shows a computer simulation image of tracking the same air target but using 
the signal filtering presented in Chapter 4. In both cases, the seeker axis is controlled by 
the method described in Chapter 3, using a modified linear-quadratic regulator (LQR). 
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Tracked target 


Impulse from the IR detector 


Seeker axis movement trajectory 


at 


Figure 8. Tracking of a detected air target without signal filtering. 


Tracked target 


Filtered impulses from the IR detector 


Seeker axis movement trajectory 


Figure 9. Tracking a detected air target using signal filtering. 


For a better comparison of the simulations shown above, Figure 10 shows the set 
trajectory Tz and the trajectory Tr pursued by the seeker axis when tracking a detected air 
target without signal filtering. 

Figure 11 shows the same trajectories after signal filtering. 

Figure 12 shows a computer simulation image of the seeker axis control in the airspace 
search phase and in the phase of tracking the detected target. Target speed: 250 m/s, target 
distance from fire station: 1100 m. 

Description of the markings used in Figures 12-14: 

A, scanning lines; B, trajectory of seeker axis motion in the programmatic airspace 
search phase; C, phase of seeker axis shifting to the detected target; D, tracking of the 
detected target. 

Figure 13 shows the differences between the set trajectory and the trajectory pursued 
by the seeker axis when controlled with the use of the PID method, while Figure 14 shows 
the differences between the set trajectory and the trajectory pursued by the seeker axis 
when controlled with the use of modified LOR method. 
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8, 8 (°) 


0 o5 1 15 2 #25 #3 35 4 
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Figure 10. Tz set trajectory and pursued Tp trajectory of the seeker axis without filtering the signals 
received from the infrared detector. 
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Figure 11. Tz set trajectory and pursued Tp trajectory of the seeker axis with the filtration of signals 
received from the infrared detector. 
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Figure 12. The process of modified LOR control of the seeker axis in the airspace search phase and in 
the phase of tracking a detected target. 


YW, Wz (°) 


Figure 13. Tz set trajectory and pursued Tp trajectory of the seeker axis in the airspace search phase 


and in the detected target tracking phase—-PID control. 
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Y, Wz C) 


Figure 14. Tz set trajectory and pursued Tp trajectory of the seeker axis in the airspace search phase 


and in the detected target tracking phase-modifiedLQR control. 


6. Conclusions 


The paper presents the application ofmodified LOR control and the estimation of 
input signals using Kalman filter for the process of detection and tracking of air targets. 

LOR regulation uses linearization of the mathematical model of the tested scanning 
seeker with the use of the so-called Jacobians, while in order to improve the stability of the 
seeker’s operation, vector selection of signals received by the optoelectronic system, which 
utilizes, among others, an extended Kalman filter, was used. 

Computer simulations have shown that tracking of the maneuvering air target by 
the seeker being studied, using a Jacobian in a closed-loop control, is more precise than 
using the classical PID control method. The results also confirm the effectiveness of the 
developed method of filtering the signals received by the optoelectronic system of the 
presented seeker. After applying the vector selection of signals and Kalman’s linear filter, 
we can clearly see a significant improvement in the stability of the trajectory of seeker 
axis motion. 

In further research, statistical results will be presented and analyzed, which will be 
compared with the results obtained in this article. Moreover, in the future, it is planned to 
conduct research on the use of a more powerful filter, the “unscented Kalman filter”, which 
was widely discussed in articles [47-51]. 
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